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LEXINGTON 


ABSTRACT 


The  purpose  of  this  report  is  to  examine  several  Kalman 
filter  algorithms  that  can  be  used  for  state  estimation  with  a 
multiple  sensor  system.  In  a synchronous  data  collection  system, 
the  statistically  independent  data  blocks  can  be  processed  in  paral- 
lel or  sequentially,  or  similar  data  can  be  compressed  before 
processing;  in  the  linear  case  these  three  filter  types  are  opti- 
mum and  their  results  are  identical.  In  multilateration  radar 
tracking  applications,  the  data  compression  method  is  shown  to  be 
computationally  most  efficient,  followed  by  the  sequential  process- 
ing, the  parallel  processing  is  least  efficient.  These  algori- 
thms are  described  in  detail  and  their  results  are  compared  with 
a suboptimum  tracking  algorithm  which  processes  only  multiple 
range  measurements.  A state  estimate  compression  algorithm  is 
also  described.  Various  radar  measurement  transformation  formu- 
las are  listed.  Algorithms  for  a nonsynchronous  data  collection 
system  are  not  examined  in  detail  but  possible  approaches  are 
suggested. 
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1.  INTRODUCTION 


Recent  studies  (Ref.  1,2)  hav^e  generated  renewed  interest 
in  multistatic  and  multilateral  radar  systems.  These  systems 
can  improve  target  tracking  accuracy  using  range  measurements 
from  multiple  radars  rather  than  range  and  angle  measurements 
from  a single  radar.  Preliminary  simulated  multi-radar  estimates 
(Ref.  3)  have  shown  promising  improvement  when  compared  to  cor- 
responding single  radar  results. 

The  purpose  of  this  note  is  to  formulate  the  Kalman  filter 
configurations  that  can  be  applied  to  multiple  netted-radar  mea- 
surement systems;  this  report  also  addresses  the  general  filtering 
problem  for  measurement  systems  with  many  simultaneous  measure- 
ments. In  Section  2 the  problem  is  aescribed  in  more  detail. 

The  two  main  tools  for  this  report  are  reviewed;  the  extended 
Kalman  filter  for  nonsynchronously  collected  measurements  from 
different  locations  in  Section  3 and  the  transformation  of  one 
measurement  system  tc  another  in  Section  4,  In  Section  5 the 
results  of  Sections  3,  4 are  combined  and  the  filter  configura- 
tions for  various  m(.asur ament  system?  are  derived  - some  of  their 
advantages  and  disadvantages  are  discussed.  Emphasis  is  on  the 
examination  of  ::  le  parallel  filter  - all  measurements  are  pro- 
of sed  simultaneously  (parallel) , the  seguentiai  filter-process- 
ing blocks  of  uncorrelated  measurements  sequentially  . and  data 
compression-compressing  the  data  before  processing.  Estimate 
compression  combines  the  filter  outputs  - comparable  to  data 
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compression.  In  Section  6 some  numerical  results  are  presented. 
Four  appendices  are  attached.  They  present  radar  measurement 
transformation  formulas,  derivation  of  data  and  estimate  compress 
sion  equations,  proof  of  filter  equivalence,  and  computational 
counts  of  various  filter  configurations. 

2.  PROBLEM  STATEMENT 

In  the  measurement  system  under  consideration  several  ra- 
dc>rs  at  different  locations  make  measurements  of  the  same  RV. 

The  accuracies  of  the  individual  radars  are  known , their  sampling 
times  may  or  may  not  be  synchronized  or  they  may  be  '“andom.  Fig- 
ure 2.1  shows  a schematic  of  such  a measurement  system;  the  mea- 
surement vector  of  each  individual  sensor  i is  subscripted.  The 
individual  radars  may  be  active  (i.e.,  transmit  and  receive)  or 
passive  (receive  only) . A system  is  defined  multilateral  if  all 
radars  are  active,  multistatic  if  there  is  one  active  and  several 
passive  radars.  Special  cases  under  consideration  are  trilaterr 
ation  (as  in  RMP-74)  wi’:h  3 active  radars,  or  a bistatic  measure- 
ment systems  with  one  active  and  several  passive  radars. 

There  does  not  exist  an  extensi^'e  literature  for  the  multi- 
ple measurement  system  as  for  the  single  observer.  This  report 
describes  and  evaluates  possible  filter  configurations.  Particu- 
lar emphasis  is  given  to  the  multiple  radar  siting  system  in  the 
context  of  BMD  for  synchronized,  non-synchronized,  and  random 
measurement  times.  Some  of  the  economics  of  implementing  the 
various  filters  will  be  discussed. 
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Simplifying  assumptions  have  been  made  including  no  wake 
contamination,  no  association  problem  (occurring  in  a multitarget 
environment),  no  sidelobe  problem,  etc.  These  problems  will  have 
to  be  solved  before  any  such  system  can  be  successfully  imple- 
mented. 

3.  THE  EXTENDED  KALMAN  FILTER  FOR  TARGET  TRACKING 

In  this  section  the  formulation  of  the  extended  Kalman 
filter  is  reviewed.  Both  nonlinear  and  linear  cases  are  outlined. 
Consider  the  RV  dynamics  that  can  be  described  by  the  n-dimen- 
sional  vector  nonlinear  differential  equation 

x(t)  = f(x(t))  + n(t)  ; x(0)  = Xq  (3.1) 

where  n(t)  is  a zero-iuean  Gaussian  white  noise  with  covariance 
Q(t)  and  x^  is  Gaussian  with  mean  x^  and  covariance  P^.  The 
measurements  are  collected  (randomly)  at  discrete  times  in  the 
form 

z(tj^)  = z = h(Xj^)+ 
k 

where  Vj^  is  an  m-dimensional  zero-mean  Gaussian  white  noise  se- 
quence with  covariance  Rj^. 

It  is  assumed  that  (3.1)  has  a unique  solution  and  can  be 
expressed  in  the  discrete  form  associated  with  (3.2) 
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=‘k=  «k-i 


IC"  X f 2 / w • * 


where{Wj^}is  an  n-dimensional  zero-mean  Gaussian  white  noise 
sequence  with  covariance  Qj^=  ®k^^k+l'^k^  ‘^^k-1  ~ ^k  ~ ^k-1 

The  exrended  Kalman  filter  associated  with  (3.1)  and  (3.2) 
is  stated  below: 


PREDICT  CYCLE: 


(State) 


^k+l/k  ~ ^k^^k/k'^\^ 


X , = X 

0/0  o 


(3.3) 


^k+l/k  " ^k/k 


f (x  (t  ) ,T  )dx 


(3.3a) 


(Covariance)  = AkVk^k  * °k  = Vo  ' "“o 

where  denotes  the  estimate  of  x at  time  tj^  based  upon  all 

A. 

the  data  up  to  time  t.  and  P,  denotes  the  covariance  of  x,  , . . 

3 V3  k/3 

/V 

Aj^  is  the  Jacobian  matrix  of  fj^  at  and  Atj^. 


A = 
k 3x 


(3.5) 


UPDATE  CYCLE: 

(State)  ’^k+l/k+l  " ^k+l/k  \+l^^k+l~  ^^^k+l/k  (3.6) 


^k+l/k“k+l^^k+l^k+l/k”\+l  \+l  ^ 


(3.7) 
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or 

^ktl  = ^ 

p R*"^ 

“^k+l/k+l  "k+1  *^k+l 

(3.7a) 

(Covariance) 

^k+l/k+1  " 

^ ^ “ \+l  ”k+l^^k+l/k 

(3.8) 

or 

^k+l/k+1 

"■kli/k  * "k.i  *i;ii 

(3.8a) 

if 

exists 

k+l/k 

where  is  the  Jacobian  matrix  of  h at 

H - 

"k+1  “ 3x 

’^“^k+l/k 

(3.9) 

If  the  measurements 

are  linear  with  respect  to  Xj^, 

then 

Eqs.  (3.2)  and 

(3.6)  become 

'k  - "k  *k 

^ ^k 

(3.2’) 

and 

^k+l/k+1 

' ’'k+l/k  * 

Ak 

^'k+l^^k+l  ' “k+1  ^k+l/k^ 

(3.6’) 

respectively. 

4.  TRANSFORMATION  OF  MEASUREMENTS 

The  need 

for  a transformation  of  measurement  arises 

r 6 • q • » 

when  the  filter  coordinate  system  is  different  from  the 
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measurement  coordinate  system.  This  is  the  case  in  particular 
when  several  radars  at  different  locations  make  measurements  of 
the  same  object. 

In  Section  3 the  nonlinear  measurement  was  presented  of  the 

form 


■k  “ + ''k 


(4.1) 


Here  we  are  concerned  with  a radar  measurement  at  a different 
location  of  the  form 


2*  = 


(4.2) 


where  is  an  m-dimensional  zero-mean  Gaussian  white  noise 

* 

sequence  with  covariance  Rj^.  To  use  Eq.  (4.2)  in  a filter  de- 
signed for  Eq.  (4.1)  the  measurement  has  to  be  transformed.  As- 
suming that  the  measurement  can  be  transformed  into  the  form  of 
Eq.  (4.1)  - in  the  deterministic  case  - Zj^  computes  to: 


(4.3) 


For  the  stochastic  case,  Eq.  (4.3)  can  be  approximated  as 


^ h(x,  ) + V, 


(4.4) 


where  is  an  m-dimensional  zero  nean  Gaussian  white  noise 

sequence  with  covariance 


* T 

R.  = G,  R.  G, 
k k K k 


(4.5) 


7 


(4.6) 


G = ^ 

S 3^* 


^ ^ A 

= *■  <=‘k/k-i> 


and  is  generated  as  in  the  previous  section  Eq.  (3.3)  at 


^k- 


After  making  the  transformation  of  Eq.  (4.3)  the  filter 
of  Eq.  (3.2)  can  be  used  by  correcting  Rj^  as  shown  in  Eq.  (4.5). 
The  H matrix  is  computed  via  Eq.  (3.9)  - as  indicated  in  Section 
3 - or  in  two  steps  as, 


'®z 


3h 

3x 


(4.7) 


x * X 


k/k-1, 


It  becomes  clear,  that  the  above  transformation  is  independent 
of  the  RV  dynamics.  In  general,  the  approximation  of  Eq.  (4.4) 

is  satisfactory  only  if  the  nonlinearities  are  small. 

Three  basic  measurement  transformations  are  considered  in 
this  report; 


I)  R-  A.  E,  to  R_  A E 
111  o o o 


II)  R.  R R-  to  R,  A,  E, 
1 2 ill 


III)  R,  R_  R,  to  R„  A„  E^ 

12  3 O O O 
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Transformation  I is  used  to  convert  the  (R,  A,  E)  data  collected 
from  one  radar  site  to  another  radar  site  or  the  origin.  Trans- 
formation II  can  be  used  to  convert  3 range  measurements  from 
three  radars  into  RAE  measurements  - either  to  use  the  data  for 
existing  RAE-filter  inputs,  or  e.g.,  to  evaluate  the  elevation 
and  azimuth  accuracies  of  the  R^^,  R2,  R^  measurements  as  compared 
to  the  R,  A,  E measurement  of  a single  radar.  Transformation  III 
is  a combination  of  I and  II.  The  transformation  formula  and  the 
associated  G matrices  (of  Eq.  (4.6)  ) are  derived  in  Appendix  A 
for  the  three  transformations. 

5 . FILTER  ALGORITHMS  FOR  MULTIPLE  SENSORS  AND  LOCATIONS 
5. 1 Introduction 

In  this  section  various  Kalman  filter  algorithms  for  sen- 
sors at  multiple  locations  are  presented.  The  major  advantage 
of  such  a multilaterated  measurement  system  is  the  possibility 
of  obtaining  more  accurate  data  for  the  tracking  filter.  Using 
the  radar  measurements  from  several  different  locations  may  re- 
sult in  a much  smaller  uncertainty  volume.  With  the  proper 
geometry  the  angle  measurements  may  become  redundant  - in  the 
sense,  that  the  processing  of  the  angle  measurements  does  not 
improve  the  estimation  accuracy  by  much.  Neglecting  them  in 
such  cases  results  in  a considerable  saving  in  computer  resources 
while  sacrificing  little  in  filter  performance.  Because  of  the 
redundancy  in  this  type  of  measurement  system  it  also  is  less 
vulnerable  against  outages  (forced  or  otherwise.) 
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Various  cases  of  data  collection  and  filter  configurations 
will  be  considered.  Both  the  synchronous  (all  sensors  collect 
data  at  the  same  time)  and  the  nonsynchronous  case  (each  sen- 
sor works  independently  of  the  others)  are  evaluated.  In  multi- 
lateration  radar  tracking  system  the  collection  could  be  either 
synchronized  or  nonsynchronized.  In  a system  of  bistatic  radars 
only  the  data  collection  is  necessarily  synchronized. 


The  radars  at  different  locations  have  different  measure- 
ment coordinate  systems  with  respect  to  a fixed  state  (or  state 
estimate)  coordinate  system.  The  Kalman  filter  can  be  designed 
to  accommodate  all  measurement  coordinate  systems  - or  the  mea- 
surements must  be  transformed  to  fit  a particular  filter  design 
as  discussed  in  Section  4.  Both  types  of  filter  configurations 
will  be  discussed. 


In  Section  5.2  three  optimal  (in  the  linear  case)  and  one 
suboptimal  filter  for  the  synchronous  data  collection  case  are 
suggested  and  investigated;  the  nonsynchronous  case  is  treated 
in  Section  5.3.  Also  described  is  the  possibility  of  prepro- 
cessing the  data  to  reduce  the  computational  requirements.  In 
Section  5.4  the  filter  performance  is  evaluated  when  only  a sub- 
set of  the  data  is  processed  and  compared  to  the  optimal  case 
for  which  all  the  data  are  processed. 
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radars  are  uncorrelated,  the  covariance  of  ^k+1' 


*^k+l, 

1 

1 1 
-4- 

0 I 

1 
1 

' ' ' n 

. 1 .1  . 1 0 

1 1 1 

1 1 1 

0 

1 

1 

1 

1 

-4- 

\+l,2[. 

1 

1 

1 

l 

• 

• 

1 

1 

1 

-J 

1 

1 

1 

1 

i 

1 

1 

1 

1 

1 

1 

1 

1 

I 

• 

1 

J. 

I 

I 

i_ 

1 

1 

t t 1 

1 1 1 R,  . . 

I 1 1 k+1, 

II  1 

(5.3) 


Using  (5.2)  and  (5.3)  in  the  filter  update  equation  and  after  a 
few  manipulations,  we  obtain 


(State) 


‘k+l/k+1 


^k+l/k  \+l,i  ^k+l,i**  ^'i^^k+l/k^^ 

(5.4) 


(Gain) 


'k+1 , i 


T -1 

^k+l/k+1  ”k+l,i  ^k+l,i 


(5.5) 


(Covariance)  P”^  + E/h"^  ^v+1 

k+l/k+1  k+l/k  i=l  k+l,i  K+l,i 

(5.6) 


where  ^ is  the  Jacobian  matrix  of  k^(Xj^_^j^)  at 


Notice  that  the  inverse  covariance  matrix  equation  is  used  in 
(5.G).  This  form  is  more  convenient  for  discussing  filter  equiv- 
alence. This  algorithm  is  depicted  in  Figure  5.1. 
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A 

^'k+l/k 

^k+l/k 


Figure  5.1  Parallel  filter 


zero 


5.2.2  Sequential  Filter 

Each  measurement  may  be  treated  as  a new  measurement  with 
zero  prediction  time  for  iM.  The  estimates  may  then  be  updated 
sequentially.  The  update  algorithm  becomes 


(State) 


^k+l/k+1  ^k+l/k  ^k+l,i 


<=^k+l,i  ■ ^i^'^k+l/k+l^i-l 


. ,))  (5.7) 


^k+l/k+1,0  ""k+l/k' 


= ^k+l/k'  ^k+l/k+1,0  " ^k+l/k 


(5.8) 


'k+l/k+l,i  " ^k+l/k+l,i-l  "^^k+l,! 


^^k+l,i  " ^i^^k+l/k+l,i-l^ 


(5.9) 


(Gain) 


^k+1 , i ^k+l/k+1 , i"l  k+1 , i 


T 

^ ^k+l,i^k+l/k+l,i-l”k+l,i  ^ ^k+l,i  ^ 


T "I 

^k+l,i  ^k+l/k+l,i  “k+l,i  ^k+l,i 


i“l,2,  ..•»  I 


(5.10) 
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(Covariance)  = ^k+l/k+l,!-!  " ^k+l,i 


^k+l/k+l,i-l 


-1  _ -1  T -1 

^k+l/k+l,i  ~ ^k+l/k+l,i-l  “k+l,i  \+l,i  ^k+l,i 


X X^2/  » m m f I 


‘k+l/k+1 


‘kfl/k+l,l 


^k+l/k+1  ^k+l/k+l,I 


(5.12) 


Notice  that  the  i-th  measurement  is  used  to  update  the  state 
estimate  at  the  i-th  step.  This  algorithm  is  illustrated  in 
Figure  5.2. 

5.2.3  Data  Compression 

All  measurements  may  first  be  combined  to  form  a pseudo- 
measurement (data  compression).  In  this  case,  the  filter  only 
needs  to  be  updated  once.  If  a weighted  least  square  criterion 
or  a Bayesian  estimation  formulation  is  used,  the  combined 
measurement  and  covariance  are* 


* For  derivation,  see  Appendix  B. 
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^k+1  \+l  ^ \+l,i  ^k+JL,i  ^ 


(5.13) 


,-l 

ic.  , , 
K*-l 


I 

E 

i=l 


R,  7i  • 
k+1,1 


(5.14) 


In  order  to  use  (5.13)  and  (5.14)  all  measurement  vectors  have  to 
be  transformed  to  a common  coordinate  system.  The  transformation 
procedure  is  discussed  in  Section  4.  Using  the  above  results, 
the  update  equations  are  unchanged  as  stated  in  (3.5),  (3.6),  and 
(3.7).  This  algorithm  is  depicted  in  Figure  5.3. 

5.2.4  Estimate  Compression 

Each  radar  may  have  its  own  filter  and  process  its  own 
measurement.  The  resulting  estimates  are  then  combined  (as  out- 
lined in  Appendix  B) . However,  since  the  (P^j  = correlation 

of  the  estimates  from  the  i-th  and  j-th  filter)  for  i?^j  are 
generally  not  available  any  compressed  estimate  is  suboptimal  and 
no  correct  estimate  of  the  covariance  matrix  exists.  An  algorithm 
for  estimate  compression  is  illustrated  in  Fig.  5.4. 

5.2.5  Algorithm  Comparison 

Four  algorithms  have  been  discussed  above.  In  the  case  of 


a linear  system  it  can  be  shown  (see  Appendix  C)  that  the  result 
ing  estimates  of  parallel  filter,  sequential  filter,  and  data 


compression  are  identical,  and  optimal.  In  Table  5.1  a cost  com- 

* 

parison  is  shown  (in  terms  of  multiplications  per  step) . The 

estimate  compression  method  requires  the  most  computations,  it  also 
does  not  result  in  a least  square  estimate  and  is  not  optimal. 

The  data  compression  method  is  computationally  more  effi- 
cient than  all  the  others.  Although  it  requires  that  all  measure- 
ments be  transformed  to  a common  coordinate,  the  filter  needs 
only  to  be  updated  once.  The  computation  requirements  between 
parallel  filter  and  sequential  filter  depend  upon  the  dimension 
of  the  state  and  the  total  number  of  measurements.  Let  n denote 
the  dimension  of  the  state  vector,  m the  dimension  of  the  mea- 
surement vector,  and  I the  total  number  of  measurements,  it  can 
be  seen  from  Appendix  D that  the  sequential  filter  is  more  effi- 
cient than  the  parallel  filter. 

The  comparison  of  all  algorithms  is  demonstrated  in  Table 
5.1  for  a particular  example  (n=7,  m=9) . 


5.3  Randomly  Collected  Data 

The  filter  prediction  and  update  process  is  carried  out 
according  to  the  availablility  of  new  data  set.  Suppose  at  time 
^k+1  only  available  data  is  from  radar  i and  let  it  be 

denoted  by  ^ and  the  update  is  performed  based  upon 

this  available  data. 

* 

The  number  of  multiplications  is  derived  in  Appendix  D. 


I 


\ 


i 
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Table  5.1  Comparison  of  algorithm  efficiency  for  synchronously 
collected  data  (i.e./  number  of  multiplications). 


(State) 


(Gain) 


(Covariance) 


‘k+l/k+1  “ ^k+1  *^k+l,i^^k+l,i  " ^i^^k+l/k^^ 


_ T -1 

^'k+l,i  = ^k+l/k+1  *^k+l,i  \+l,i 


(5.17) 

(5.18) 


^k+l/k+1  ^k+i/k  ^ ”Ll,i  \+l,i  ^k+l,i  (5.19) 


If  the  filter  is  restricted  to  accept  data  only  in  a fixed 
measurement  coordinate  system  and  must  be  first 

transformed  into  that  coordinate  system.  The  resulting  update 
equations  are  the  same  as  (3.5),  (3.6),  and  (3.7).  These  two 
cases  are  illustrated  in  Fig.  5.5. 

The  draw  back  of  a nonsynchronous  data  collection  system 
is  in  its  high  computational  requirements.  This  is  caused  by  the 
fact  that  the  filter  must  be  updated  sequentially,  and  the  data 
compression  scheme  can  not  be  applied. 

Two  alternatives  exist.  The  first  one  is  simply  to  insist 
on  a synchronous  data  collection  system.  This  is  possible  if  bi- 
static radars  are  used  or  if  sufficient  communication  exists  be- 
tween transmitters  so  that  data  can  be  collected  synchronously. 
The  second  alternative  is  to  prepx'ocess  the  data  for  time  align- 
ment. A polynomial  data  smoother  could  be  used  as  a data  pro- 
cessor for  data-time-alignment , similar  to  the  one  discussed  in 
(Ref.  4)  . 
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TN-76-21  f5.5^ 


‘k+l/k 


k+l/k 


1-ilter  with  i-th 
Radar  Measurement 
Equations 


k+l/k+1 


k+l/k+1 


Figure  5.5-a  Filter  equipped  with  all  measurement  equations  for 
randomly  collected  data. 


^k+l/k  ^k+l/k 


'k+3  ^ i 


Transformation 

From  i-th 

^kt-1 

Radar  to  the 

• Filter 

Fixed  Coordi- 

nate 

— — _ 

'k+l/k+1 


k+l/k+1 


Figure  5.5-b  Filter  with  a fixed  measurement  coordinate  for 
randomly  collected  data. 


5.4  Options  of  Processing  all  or  Part  of  the  Measurements 


In  a data  collection  system,  part  of  the  measurements  may 
be  of  poorer  quality  (low  SNR)  than  the  others.  If  the  remaining 
(high  SNR)  measurement  still  constitutes  an  observable  system, 
the  noisy  measurements  may  be  neglected  with  trade-offs  in  compu- 
tation and  performance. 

This  situation  is  particularly  true  in  a multilateration 
tracking  system.  The  range  measurement  accuracy  is  usually 
better  than  that  of  the  angle  (cross*5'range)  measurement  for  a 
single  radar.  Several  radars  looking  from  different  locations 
may  result  in  much  improved  uncertainty  volume  even  if  only  range 
measurements  alone  are  used.  When  only  range  measurements  are 
processed  in  the  filter,  the  computation  requirements  are  reduced 
over  even  the  data  compression  method  - which  was  the  most  effi- 
cient filter  in  terms  of  computation.  Two  methods  may  be  used 
in  applying  multiple  range  measurements  to  a tracking  filter. 

(a)  Range  measurements  from  several  measurement 
locations  (at  least  three)  may  be  used  to 
form, a set  of  pseudo-measurements  (range  and 
angles)  for  a "virtual"  radar.  For  proper 
geometry  the  effective  angle  measurement 
standard  deviations  can  be  considerably  smaller 

than  those  obtained  in  a conventional  radar 

—4  —3 

system  (of  the  order  of  10  radian  vs  10 
radian) . 
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(b)  The  range  measurements  may  be  diredtly 

processed  by  the  tracking  filter  without  ' 

going  through  the  transformation  illustrated 
above.  This  method  uses  less  computation  than 
the  method  described  in  (a) . A filter  which 
accepts  range  and  angles  will  have  to  be  modi*- 
fxed  to  accept  several  ranges  simultaneously. 

In  the  case  of  a linear  system  and  measure- 
mentS/  it  can  be  shown  that  there  is  no 
difference  in  performance  in  using  either 
method,  in  the  case  of  a nonlinear  system 
such  as  the  RV  tracking  system^  it  is  expected 
that  both  methods  will  achieve  close  performance. 

It  will  be  shown  in  the  numerical  results  that  with  proper 
geometry /processing  range  measurements  alone  can  achieve  virtually 
the  same  performance  as  processing  all  the  measurements. 

6,  WUMERICAL  RESULTS 

The  parallel,  sequential  and  data  compression  filters  were 
tested  in  a RV  siruulation.  The  reentry  geometry  is  shown  In  Fig. 
6.1,  The  estimation  results  for  these  various  nonlinear  filters 
are  extremely  close  - for  linear  filters  in  other  runs  they  were 
shown  to  be  equal.  The  statistics  for  the  nonlinear  filters  are 
identical . 
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In  Pigs.  6.2  - 6.5  the  RMS  position  apd  velocity  errors 


are  shown  for  2 geometries  for  the  following  i^asurement  configu- 
rations : 

Radar  1j  R,A..E 
Radars  1,2,3:  R^  ; i=l,2,3 

Radars  1,2,3:  (R,A,E)^  ; i=l,2,3 

At  low  altitudes  (<20  km)  geometry  I has  smaller  RMS  errors:  at 
higher  altitudes  (>20  km)  geometry  II  seems  favorable. 

For  the  radar  measurement  accuracies  used,  the  trilater- 
ation  results  {3  radars-range  only)  are  better  than  the  typical 
single  radar  results  (by  a factor  2-S).  The  trilateration  results 
for  3 radars  (R,A,E)j^;  i“l,2,3  show  only  marginal  improvements 
when  compared  to  the  3 radar  - range  only  - results.  It  should 
be  pointed  out  that  the  improvement  due  to  trilateration  will  be 
much  greater  if  the  range  accuracy  is  improved  or  if  the  angle 
accuracy  of  the  single  radar  is  reduced. 
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Velocity  RMS  Error  {m/sec) 


REFERENCES 


1.  I.  Kupiec,  "Assessment  of  Miss-Distance  Achievable  by  a 
Trilateration  Radar  System,"  Project  Report  RMP-74,  Lincoln 
Laboratory,  M.I.T.  (in  preparation). 

2.  J.  E.  Salah,  private  communications. 

3.  C.  B-  Chang  and  D.  Wi liner,  "Multi lateration  Tracking  with 
Monostatic  and  Bistatic  Measurements,"  Project  Report  RMP-86, 
Lincoln  Laboratory,  M.I.T.  (5  April  1976). 

4.  Y.  Bar-Shalom,  "Redundancy  and  Data  Compression  in  Recursive 
Estimation,"  IEEE  Trans.  Automatic  Control  AC-18,  684-689, 
(1973) . 


32 


Cl  = Xi(x-Xi)  + yiCy-Yi) 

A A 

^2  " ' yi(x-Xi) 


we  have 


AAA  A A 


'^11  / Vi 


A A 


^12  = ^2''% 


A A A A 


913  = - zCi/R^ri 

2 


A A A ‘ 


921  “ - =2-'Vo 

A A A ^ ^ 

^22  “ [‘^1^=1  ] 


^23  ^ 


'31 


'32 


2' "1^0 
A A 

2 Z 


Lr 


1 

A 

2 

A 

R_ 


R- 


'll 


I'-'. 


9i2/’^0 


®33  g 


(bj  RAE  - System 


AAA 


R^,A^,E^  - from  the  predicted  state  vector 


= R^cosE^ 
o o o 


2 = R^sinE^ 
o o 


X = r^sinA^ 
o o 


y = r cosA 
^ o o 


then  apply  the  same  formulas  in  (a)  to  obtain  Gj^. 
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(II)  Transformation  II:  From  (Rj^,R2/R3)  to  (Rj,Aj^,Ej^) 

Given  (see  Figure  A. 2): 

Radar  I at  (0,0,0)  measures  R^^  or  (Rj^,  Aj^,Ej^) 

Radar  II  at  (X2,Y2»0)  measures  R2 
Radar  III  at  (X3,y2,0)  measures  R^ 

Transformation  Formula: 

Rl  = R^ 

, ^ -l,x. 

Aj^  = tan  (-) 

E,  = sin~^(^) 

x = a^R^+a2R2t3  3*^3taQ 
y - bjR^tbjR^+bjR^b^ 

z = [hJ  - (x^+y^)]"* 

" ^o  '^2"  "Vs'  ^3"V2' 

bl  = [^2‘“^3^  '^2"  S^3'  ^3"  “V2'  *^o"‘^o^^2^3"^3^2^ 

c = /[2(x2y3-X3y2)]  , 


The  Gj^  Matrix: 


(a)  xyz  - system 


x,y,2  from  the  predicted  state  vector 
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, f"2  i "21  *1 

'i ' ho  " J 

^2  = |^(x~x2)^  + (y-y2)^  + 2^  j 

r,"  V 2 ,2  "2  1*5 


we  have 


= 1'  <3io  = 0'  = 0 


’21  = 2R^(aj^y  - b^x)/r^ 


= 2R2 (a2y  - b,x)/r 


2 ""o 


’23  “ 

A 

R ^ ^ 

9ti  ~ A x ( l“2a, X”2b^y)  ~ - 

r^z  ^ ^ R.r 

o 1 o 


[ajJ  + bjjj 


^^3  r ''  ^ T 

n ] 

o 


b)  RAE  - System 


“ frnm  the  predicted  vector 


r„  = R,cofE, 
oil 


A /\  A 

z = Rj^sinEj^ 


A A A 

X = r sinA, 
o 1 


m 


y = bjR2+b2R^+b3R5+b^+yj^ 


r„2  2 2 

R -X  -y 

o 


1 H 


The  G,  Matrix; 
-k 


(a)  xyz  - system 

/\  /V  A 

x,Y,2  - from  the  predicted  state  vector 

h 


r = 
o 


R = 
o 


= 


^2  = 


’"■2  ''2  1 
X +y  J 

'2^^2  1 

c +z 

O J 


(x-x,)  + (y 


A A A 0^0 

(X-X2) ^ ^ 


. ;■] 
] 


R- 


A 

= (X- 


A A A ^ 0 

x,)^  + (y-y3)^  + 


% 

*5 


we  have 


l+2aj^x j^+2bj^y ^ '*^^0 

^12  ^ ^^2  [^2^l'^*^2^l]  /^o 
^13  ""  ^^3  [^3^l'^^3^l]  /^o 

A p A ^ *1  ^2 

^21  = ^"1  ^’=0 

922  = ='"2  [®2y-Vj/'^o 

A f-  A '***1^0 

g,3  = 2R3  [ajy-bjx  J /r^ 


A 

^k/k-1* 
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appendix  b 

privation  of  Data  and  Estimate  Compression  Equation s 

Let  denote  the  measurement  (or  estimate)  of  x from  the 
i th  sensor  (estimator)  with  mean  x and  covariance  Pj_j^.  In  addi- 
tion, it  is  assumed  that  the  correlation  between  x.  and  x.,  F^j, 

is  known  and  x.,  i=l n and  x are  all  expressed  in  the  same 

coordinate,  then 


>ii  = ?<  + Hi 


(B.l) 


A weighted  least  square  estimate  of  x from  x.,i=l,...,N  is  the 
which  minimizes 


/\j  T — 1 'V/ 

J = (x  - Hx)  P -^(x  - Ifx) 


(B.2) 


'’12  '’in 


where  P - P^^  — 


P . P P 

Ni  N2  ^NN 


H = 


1=  an  identity  matrix  with  the  same  order  as  x.  The 
;olution  is 


T -1 
HP 


'Xj 

X 


(B.3) 


(h"^  P ^ H)  ^ = covariance  of  x 


(B.4) 


If  the  order  of  x is  n,  then  the  dimension  of  P is  (nHxnH) . The 
above  equations  require  the  inverse  of  a large  size  matrix.  For 
the  case  when  = 0 V i?« j , the  above  equations  may  be  simpli 


fied  to 


(B.5) 


(B.6) 


Notice  that  in  this  case  the  matrices  to  be  inverted  have  dimen- 
sion (nxn) . 


In  the  data  compression  case,  the  measurements  are  uncorre- 
lated. Equations  (B.5)  and  (B.6)  are  used  for  this  purpose.  For 
the  estimate  compression  case,  the  estimates  are  correlated.  In 
order  to  optimally  use  estimate  compression,  one  has  to 

(a)  Compute  all  correlations,  Vi=j 

(b)  Invert  a large  matrix,  P. 

Both  are  optimum,  however  the  estimate  compression  is  computation- 
ally extremely  inefficient. 


APPENDIX  C 


Proof  of  Filter  Equivalence 


In  this  Appendix,  the  equivalence  of  sequential  filter, 
parallel  filter,  and  the  filter  using  compressed  data  are  shown. 
It  should  be  noted  that  they  are  equivalent  only  in  the  linear 
case.  The  results  for  nonlinear  systems  such  as  RV  tracking 
should  still  be  close  to  optimal.  The  prediction  equations  of 
the  three  filters  are  the  same.  Only  the  equality  of  the  update 
equations  need  to  be  proven.  The  equations  of  the  parallel  fil- 
ter will  be  used  as  the  reference.  All  the  other  filters  v/ill 
be  hown  to  be  the  same  as  the  parallel  filter.  For  convenience, 
the  update  equations  of  the  parallel  filter  are  restated  below. 


(State) 


-k+l/k+1  " -k+l/k  \+l,i  ^^k+l,i 


^k+l,i  -k+l/k ) 


(Gain) 


_ T -1 

^k+l,i  ~ ^k+l/k+1  ^k+l,i  ^k+l,i 


(C.l) 


(C.2) 


(Covariance) 


(C.3) 


The  proofs  are  stated  individually. 
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(a)  The  equivalence  of  the  sequential  filter. 


The  covariance  matrices  can  be  easily  shown  to  be  the  same. 
Iterating  {5.11a)  I times  yields 


k+l/k+l,I  k+l/k 


“1  T 

= P,.-",  + I 


B.:}.  . H, 


k+l,i  k+l,i  k+l,i 


(C.4) 


k+l/k+l,I  k+l/k+1 


This  is  the  same  as  (C.3).  Next  we  show  the  state  estimate  equa- 
tion. Substituting  (5.8)  and  (5.9)  to  (5.7)  and  after  a few 
manipulations  , we  obtain 


. . I-l  1 

-k+l/k+1  " -k+l/k  **  ^k+l,j”k+l, \+l,i 


^-k+l,i  “ ”k+l,i  -k+l/k^ 


^ S+l,l'-k+l,^  ^k+l,I  -k+l/k^ 


(C.5) 


where  I = an  identity  matrix,  and  ^ is  the  gain  defined  by 

(5.10),  not  (C.2).  The  are  equal  when  i=I.  Using  the  following 
relation  of  the  sequential  filter, 

^k+l/k+1, i+1  = " ^k+l,i+l  *^k+l,i+l^ ^k+l/k+1, i (C.6) 


then 


j=i+l  ~ ^k+l,i 


^J[^2  ~ ^’^■*■^'3  ”k+l,j^  “ *^k+l,i+l  ”k+l,i+l^ 


T -1 

^k+l/k+l,i  \+l,i  \+l,i 


j J+2  “k+l,j^  Vl/k+l,i+l  ”Ll,i 


T -1 

^k+l/k+l,I  *^k+l,i  \+l,i 


T -1 

'’k+l/k+l  “k+l,!  "k+l.i 


This  completes  the  proof. 


(b)  The  equivalence  of  the  filter  using  compressed  data. 

In  order  to  use  the  data  compression  method,  all  measure- 
ments must  be  first  transformed  to  a common  coordinate,  i.e.. 


they  must  have  the  same  measurement  matrix.  Let  the  measurement 


I 


of  the  i-th  sensor  be  denoted  by  the  transformation  by 

, and  the  transformed  measurement  by  then 


“k+1 , i 


T . z,  . , 

1— k+1 , 1 


= T.  H,  . 1 + T.n,  . 

1 k+1,1  k+1  1 k+1,1 


(C.7) 


and 


T-  H,  . = H,  , , for  ail  i=l, 
1 k+1,1  k+1 


It  should  be  noted  that  the  transformation  may  not  exist  for 
all  i.  They  do  exist  however  for  the  multistatic  radar  applica- 
tion discussed  in  this  report.  The  covariance  of  ^ is 

’'k+i,i  °*  ’'i  "kti.i  '*kti,i ' ’'i  ''k+1,1  ■''i  • 

compressed  covariance  is  denoted  by 


I 

E 

i=l 


R,  . . 
k+1,1 


i=l 


k+1 , 1 


(C.8) 


Applying  the  above  results  to  the  filter  covariance  equations 
yields 


% 

I 
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^k+l/k+l  ^k+l/k  ■''  ”k+l  '*k+l  ”k+l 


" "“kil/k  + Cl  Cl,l  «k+l 


— 1 T "*1 

" ^k+l/k  ^k+l,i  \+l,i  ”k+l,i 


This  proves  that  the  covariance  propagates  the  same  way.  Next 
we  show  the  state  estimate.  Let  denote  the  compressed  data, 

then 


^ A rji  ^ — i 

?^k+l/k+l  ^ -k+l/k  ^k+l/k+1  “k+1  \+l  ^-k+1  **  ”k+l  -k+l/k^ 


T *“1 

-k+l/k  ^k+1,  k+1  ^k+1  \+l  *'  k+l,i  "'k+l,i 


E 1 z,' 


“k+1  -k+l/k ^ 


= X 


ik+i/k  + ''k+i/k+i  "k+i  'iii  Vi,i  s'k+i,i 

I 

i=l  -k+l/k^ 


T -1 

hL-,  ( E R' 


-k+l/K  ^k+l/k+1  ”k+l  ^k+l,i^^k+l,i  “ “k+1  -k+l/k 


APPENDIX  D 

Computational  Efficiency  of  Various 
Kalman  Filter  Configurations 

The  computational  requirements  of  an  algorithm  can  be  esti- 
mated by  the  number  of  multiplications  per  cycle.  One  cycle  of 
a Kalman  filter  can  be  divided  into  predict  part  (subscript  p) 
and  update  part  (subscript  u) . Using  the  standard  formula  the 
number  of  multiplications  M is  computed,  assuming  that  the  compo- 
nents of  the  measurement  are  independent  and  taking  advantage  of 
the  symmetric  matrices  i.e.,  only  the  upper  triangular  matrix  has 
to  be  computed. 


D.l  Predict  Part 

'Xj  rp 


P = APA  + Q 
A,P  nxn 


1* 

Product 

# of  multiplications 

3 

PA 

n 

i /V  /s 

X = Ax 

r 

a(pa'^) 

H n^  (n+1) 

t ^nxl 

i 

Ax 

2 

n 

M„  = I-  n^  (n+1) 


1 

! 

j 

'1 

I 


D.2.1  Update  via  Inverse 

"'"-1  T -1  -1 

P = (P  + HR  H) 


P H R = 

nxn  mxn  m ‘ ■*■’ 


Product # of  multiplications 

T -1  12  3 

H R H i n m + f nm 


3,3  , 

-2-  (n  -n) 


I (n^-n) 


T -1 

K=P  (HR  ) 

nxn  nxm 

2 

n m 

•X, 

z - Hx  , k(z  - z) 

2nm 

M^^j=nm  (f  ^ + f (n^-n) 


D.3  Data  Compression 

given:  k m-dim.  data  sets  i=l,  •••»  k 

1)  transform  to  z^  - coordinate  system 

2)  transform  diagnoal  covariance  matrices  R^ 

3)  compress 


Product 


13  2 

k i (m-'+  3^^) 
2 m 


(k+1)  I (m^-  m) 


(k+l)m" 


k+|)  + m"  (j  k+1)  - m|(k+l) 


D.4  Estimrite  Compressior. 


given;  k n - dim.  estimates  x.,  i=l,...,k 

using  only  the  P.  . matrices  (the  Pi-^  j^i  matrices 
are  not  available^"  the  # of  multiplications  for 
the  compressed  estimate  is  computed. 


Product 


# of  results 


P.Tl 

11 


(k+1)  |(n^-n) 


-1  -1  -1  ^ 
(Zp.  . ‘-)  -^(IP.  . X.) 

' 11  ' 11  1 


(k+l)n' 


= (k+l)n  l-(n^-l)  +n 
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